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According  to  the  requirements  of  the  precision  guidance  of  air-to-surface  weapons  with  multiple  con¬ 
straints,  a  new  optimal  guidance  law  applying  to  attack  the  ground  stationary  target  is  designed.  On 
the  basis  of  dividing  the  3D  movement  of  the  weapon  into  the  movements  of  diving  plane  and  turning 
plane,  the  relative  motion  of  weapon-target  is  established  first.  Considering  the  conditions  of  miss  dis¬ 
tance,  impact  angle  and  terminal  angle  of  attack,  the  general  formulation  of  a  new  guidance  law  with 
an  arbitrary  system  order  is  deduced  by  solving  the  Riccati  equation  of  the  quadratic  optimal  control. 
The  approximate  expressions  of  lag  free  system  and  first-order  lag  system  are  given.  The  validity  of  the 
optimal  guidance  law  is  verified  by  the  comparable  simulations  of  the  characteristic  trajectory.  The  sim¬ 
ulation  results  shows  that  the  optimal  guidance  laws  satisfy  the  precision  guidance  with  impact  angle 
constraint  as  well  as  the  angle  of  attack  converges  to  zero  at  final  time,  which  is  important  for  warhead 
effect. 

©  2013  Published  by  Elsevier  GmbH. 


1.  Introduction 

The  main  objective  of  guidance  systems  for  air-to-surface  weapons  is  to  generate  suitable  commands  that  produce  zero  terminal  miss 
distance.  In  some  cases,  however,  many  kinds  of  guided  weapons  are  expected  not  only  to  get  a  minimum  miss  distance  but  also  to  achieve 
a  desired  impact  attitude  angle,  so  that  the  warhead  of  the  weapons  can  acquire  a  better  kill  effect.  The  impact  precision  requirements  are 
so  stringent  that  the  conventional  guidance  laws,  such  as  the  proportional  navigation  guidance  (PNG)  law,  cannot  direct  the  vehicle  to  the 
target  and  achieve  the  desired  impact  direction. 

Terminal  guidance  of  reentry  vehicles  with  constrained  attitude  angle  at  impact  is  studied  by  applying  linear  quadratic  optimization 
techniques  in  Ref.  [1  ],  which  seems  to  be  a  pioneering  research  on  this  area.  For  the  past  few  decades,  a  variety  of  methods  for  guidance 
laws  with  terminal  impact  angle  constraints  have  been  extensively  studied.  Based  on  the  different  fundamental  theories,  the  existing 
guidance  laws  are  categorized  into  modified  PNG  laws,  optimal  guidance  laws,  variable  structure  guidance  laws  and  other  guidance 
laws. 

The  proportional  navigation  (PN)  and  its  variants  have  been  extensively  studied  and  widely  used  as  the  homing  guidance  laws  for 
short-range  intercept  because  of  their  simple  structure,  mature  theory  and  their  ease  of  implementation.  A  variation  of  the  conventional 
PNG  law  with  supplementary  time-varying  bias  is  proposed  in  Ref.  [2]  to  fulfill  a  special  guidance  goal  that  impact  a  target  with  a  desired 
attitude  angle.  Based  on  the  principle  of  following  a  circular  arc  to  the  target,  a  precision  guidance  law  with  impact  angle  constraint  for 
a  two-dimensional  planar  intercept  is  derived  in  Ref.  [3].  Reference  [4]  considers  the  problem  of  guiding  a  hypersonic  gliding  vehicle  in 
the  terminal  phase  to  a  target  location  and  derives  an  adaptive  PN  guidance  to  direct  the  vehicle  to  a  ground  target  with  specified  impact 
direction.  A  track  forecast  guidance  law  is  presented  in  Ref.  [5]  to  meet  the  requirement  of  impact  angle  and  to  hit  targets  precisely  based 
on  traditional  PNG. 

The  second  category  comprises  the  research  in  which  the  terminal  impact  angle  controllers  are  given  as  optimal  solutions  by 
using  optimal  control  theory  and  the  associated  linear  quadratic  optimal  control  theory  [6-8].  A  practical  terminal  guidance  law  is 
presented  in  Ref.  [9]  for  impact  angle  control  to  enhance  terminal  effectiveness  of  anti-tank  and  anti-ship  missile  systems.  An  opti¬ 
mal  guidance  law  with  the  capacity  of  adjusting  terminal  maneuver  acceleration  is  studied  in  Ref.  [10]  to  control  impact  angle  as 
well  as  miss  distance.  A  generalized  formulation  of  energy  minimization  optimal  guidance  law  for  constant  speed  missiles  with  an 
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Fig.  1.  Coordinate  system  and  geometry. 


arbitrary  system  order  is  proposed  in  Ref.  [11]  to  achieve  a  desired  impact  angle  as  well  as  zero  miss  distance.  An  optimal  guid¬ 
ance  law  with  terminal  constraints  of  miss  distance  and  impact  angle  is  obtained  in  Ref.  [12]  as  the  solution  of  a  linear  quadratic 
optimal  control  problem  with  the  energy  cost  weighted  by  a  power  of  the  time-to-go.  With  the  optimal  control  theory  and  precise 
linearization  method,  the  reentry  maneuverable  warhead  guidance  scheme  design  problem  is  transformed  to  linear  system  synthe¬ 
sis  problem  in  Ref.  [13].  A  three-dimensional  guidance  law  with  terminal  impact  angle  constraint  by  using  Lyapunov  stability  theory 
is  proposed  in  Ref.  [14  .  Reference  [15]  deals  with  the  guidance  and  control  system  to  impact  a  target  with  a  desired  impact  angle 
for  precision  guided  bombs  and  the  impact  angle  control  guidance  is  derived  by  the  solution  to  the  linear  quadratic  optimal  control 
problem. 

The  variable  structure  control  (VSC)  theory  and  associated  sliding  mode  control  (SMC)  have  been  developed  and  applied  enor¬ 
mously  in  the  past  few  decades  due  to  the  inherent  robustness  and  relatively  simple  control  algorithm  of  the  VSC  system  [16-18]. 
A  ‘homing’  guidance  with  terminal  angular  constraint  is  stated  in  Ref.  [19]  by  employing  a  Lyapunov-like  function  with  the  sliding 
mode  control  methodology.  A  variable  structure  midcourse  guidance  law  with  terminal  angle  constraint  is  proposed  in  Ref.  [20]  base 
on  the  concept  of  virtual  target.  Reference  [21]  presents  a  variable  structure  guidance  law  with  constraints  on  impact  angle  which 
can  be  implemented  conveniently  with  little  target  information.  Reference  [22]  deals  with  a  new  passive  homing  guidance  law  for 
a  stationary  or  a  slowly  moving  target  using  sliding  mode  control  technique  and  designs  a  guidance  law  that  can  control  a  terminal 
impact  angle  to  maximize  warhead  effect.  By  combining  the  linear  quadratic  optimal  theory  and  the  VSC  methodology,  a  3-dimensional 
robust  guidance  law  is  developed  for  impact  angle  control  in  Ref.  [23].  An  approach  to  impact  time  and  angle  guidance  through  a 
combination  of  a  novel  line-of-sight  (LOS)  rate  shaping  technique  and  a  new  second-order  sliding  mode  approach  is  presented  in  Ref. 
[24]. 

From  above  studies,  we  can  notice  that  nearly  all  of  them  only  take  few  constraints  during  the  design  of  terminal  guidance  laws.  But 
for  the  problem  of  the  precision  guidance  with  multiple  constraints  in  the  modern  air-to-surface  weapon,  it  is  necessary  for  us  to  take  into 
account  multi-constraint  conditions  simultaneously,  such  as  miss  distance,  impact  angle,  orientation  angle,  angle  of  attack,  etc.  References 
[11,25]  deduce  a  new  guidance  law  which  considers  the  constraints  of  miss  distance,  impact  angle  and  system  dynamics,  but  they  only 
gives  an  approximate  expression  of  zero-order  lag-free  system  and  neglect  the  delay  factors  in  missile  system  such  as  autopilots,  actuators 
and  dynamics. 

In  this  paper,  we  try  to  add  the  terminal  angle  of  attack  constraint  to  the  derivation  of  optimal  guidance  law  in  addition  to 
the  requirements  of  miss  distance  and  impact  angle.  Section  2  describes  the  weapon-target  engagement  model  and  establishes  the 
state  equations  of  motion.  Section  3  derives  the  general  formulation  of  optimal  guidance  law  with  terminal  angle  of  attack  con¬ 
straint  by  solving  the  Riccati  equation  of  the  linear  quadratic  optimal  control.  Considering  the  system  dynamics  and  the  lag  time 
attributed  to  the  transfer  of  input  commands  to  output  reaction,  the  analytical  guidance  formulations  based  on  the  lag  free  sys¬ 
tem  assumption  and  first  order  lag  system  approximation  are  presented  in  Sections  4  and  5,  respectively.  The  validity  of  the  derived 
optimal  guidance  laws  is  verified  by  the  comparable  simulations  of  the  characteristic  trajectory  with  conventional  optimal  guid¬ 
ance  laws  in  Section  6.  The  simulating  results  show  that  the  angle  of  attack  converges  to  zero  at  final  time  when  applying  the 
optimal  guidance  law  with  terminal  angle  of  attack  constraint,  which  satisfies  the  precision  guidance  and  is  important  for  warhead 
effect. 


2.  State  equations  of  motion 

In  order  to  simplify  the  equations  of  the  striking  situation,  the  weapon-target  engagement  model  is  divided  into  diving  plane  and 
turning  plane  as  shown  in  Fig.  1.  An  earth-fixed  coordinate  system  is  defined.  The  target  is  stationary  and  stays  at  the  origin  of  the 
coordinate  system.  They-axis  is  pointed  to  the  up  and  deviates  from  the  Earth  center,  the  x-axis  stays  in  the  horizontal  plane  and  is  pointed 
to  the  weapon,  and  the  z-axis  completes  the  right-hand  system.  It  is  also  assumed  that  the  angle-of-attack  is  small  and  its  velocity  is 
constant. 
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The  standard  three-dimensional  equations  of  motion  of  the  guided  weapon  over  a  flat  earth  can  be  represented  by  the  following 
nonlinear  differential  equations. 


^  (Pc osacosfi-X)  P  [xcosPcosct  +  (y  +  Ro)sin0-zcos6>sin<7] 


(Psina  +  V)  /i  [xsinPcosCT  -  (y  +  Ro)cosP-zsinPsina] 

0  =  - 7 - T - 1 - 


( mv ) 

P  cos  a  sin  $  -Z 


li 


[r3v) 

(xsina  +  zcos<r) 


mvcosO  r3vcos6 
x  =  vcosOcoscr  y  =  vsinO  z  =  -vcos6sincr 


(1) 


where  x,  y,  z  are  the  change  rate  of  position  coordinates  x,  y,  z,  respectively,  v  is  the  earth  relative  velocity  and  v  denotes  the  acceleration. 
The  flight  path  angle  and  angular  rate  are  0  and  6 ,  while  the  velocity  deflection  angle  and  angular  rate  are  o  and  a.  a  and  are  the  angle- 
of-attract  and  angle-of-sideslip  respectively.  X,  Y  and  Z  represent  the  drag,  lift  and  side  force,  r  is  the  radial  distance  from  the  center  of  the 
earth  to  the  weapon  and  /i  is  the  gravitational  constant  while  R0  denotes  the  mean  radius  of  the  Earth.  The  propulsion  P  and  mass  m  are 
all  constants. 

As  shown  in  Fig.  1 ,  the  motion  of  weapon  can  be  decomposed  in  diving  plane  and  turning  plane.  The  LOS  p  from  the  target  to  the  weapon 
is  defined  by  elevation  angle  \d  and  azimuth  angle  XT.  vD  and  vF  are  the  velocity  decomposition  respectively  in  diving  plane  and  turning 
plane.  Xjj  is  the  azimuth  angle  in  the  turning  plane.  The  equation  of  weapon-target  relative  movement  can  be  found  in  Ref.  [26]. 


XD  =  ( 

fV-  -  2—^ 

^■D  ~  P  — 

PJ 

P 

Xrr  = 

(-  —2  — 

)^TT  +  P^ 

\v 

p, 

>  P 

where  yD  and  yT  denote  the  azimuth  angle  of  velocity  in  diving  plane  and  turning  plane  respectively,  and  their  angular  rate  are  yD  and  yT. 
p  is  the  change  rate  of  LOS.  XD  and  XD  are  the  angular  rate  and  angular  acceleration  of  elevation  angle  XD,  Xjj  and  Xjj  denote  the  angular 
rate  and  angular  acceleration  of  azimuth  angle  in  the  turning  plane  Xjj. 

It  is  known  that  the  movement  of  ground  striking  weapon  is  mainly  in  the  diving  plane  and  the  side  guidance  has  less  impact  on  the 
precision  of  miss  distance  and  terminal  attitude  angle,  so  we  only  discuss  the  optimal  guidance  law  derivation  of  diving  plane.  From  (2) 
and  the  velocity  is  assumed  to  be  a  constant,  the  state  equations  of  motion  in  diving  plane  are  as  follows 


Xd  =  Ad*d  +  BdUd 


(3) 


where  xD  = 


Ud  =  Yd, 


Tg  =  -  - t-.Ydf  denotes  the  desired  impact  angle,  which  is 
P 


^ d  +  Ydf\  a  _  f  0  1  \  R_[° 

XD  )’  D  (o  2 /Tg)'  D  y-i  /Tg 
a  constant  since  the  target  does  not  maneuver. 

In  addition  to  the  miss  distance  and  impact  angle  constraints,  zero  angle  of  attack  constraint  should  also  be  considered  in  the  design  of 
terminal  guidance  law.  In  order  to  take  these  three  constraints  into  account,  following  performance  index  should  be  selected. 


J  = 


[X(t/)  -  X/]  rF  [X(t/)  -  X/]  |  /q^  uT(r)Iu(r)dr 


(4) 


T 

where  X  =  (XD  +  yDF,  XD,a)  .  F  and  I  denote  the  symmetric  nonnegative  and  positive  definite  matrices,  respectively,  tf  and  Xf  are  the  time 
of  flight  and  the  specified  terminal  constraints,  respectively.  To  ensure  X(fy)->  ( 0,  0,  0)T,  the  optimal  control  should  be  derived.  Because 
the  angle  of  attack  cannot  be  measured  and  controlled  easily,  we  cannot  choose  angle  of  attack  as  the  direct  control  variable.  Based  on  the 
aerodynamics,  the  following  approximate  expression  holds. 


Y  =  qS(Cyd  +  Cy8) 


where  q  is  the  dynamic  pressure  and  S  denotes  the  reference  area.  C“  and  Cy  are  the  aerodynamic  coefficients.  8  is  control  piston  deflexion 
angle.  Under  the  balance  state,  C^8  is  relative  small,  so  the  terminal  zero  angle  of  attack  condition  can  be  transformed  to  the  problem  of 
nulling  terminal  acceleration  command. 

In  order  to  achieve  the  goal  of  angle  of  attack  control,  the  dynamic  characteristic  of  the  weapon  should  be  introduced  into  the  movement 
model.  The  dynamics  of  the  weapon  system  with  scalar  input  uD(t )  can  be  represented  by  Ref.  [27]. 


< 


*D1 

*D2 


( Gil  012 
\  «21  022 


Uo(t) 


(5) 


where  the  acceleration  aD  is  the  first  state  variable  and  the  vector  PD  consists  of  the  rest  n-1  state  variables.  Therefore,  au  and  b\  are 
scalars;  a\2 ,  and  b2  are  (n-1)  x  1  vectors;  a22  is  a  (n-1)  x  (n-1)  matrix. 

Because  aD  «  -pyo  and  yD  is  proportion  to  a ,  then  combine  (3)  with  (5),  we  can  get  the  general  state  equations  of  motion  in  diving 
plane. 


X  =  AX  +  Bu 


(6) 
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,  B  =  ( 0  0  b\  b2  )'  ,  u  =  aD. 
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0  2/Tg  1/p  0 
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0  0  CZ21  CI22 

Considering  the  multi-constraint  conditions  of  XD  +  yDF  =  0,XD  =  0  and  a  =  0  (aD  =  0)  at  impact  moment,  the  terminal  constraints  of  (5)  is 


where  X  =  (x-i,x2,x3,x4jr  =  (XD  +  yDF,  kD,  aD,  pDf,  A  = 


Xf  =  ( 0,  0,  0,  x4f)T 


(7) 


3.  General  formulation  of  optimal  guidance  laws 


Based  on  the  linear  differential  equation  in  the  air-to-surface  striking  problem  given  above,  let  us  consider  the  following  optimal  control 
problem  with  terminal  acceleration  constraint:  in  order  to  achieve  better  kill  effect,  we  choose  (4)  as  the  performance  index,  which  reflects 
the  minimum  miss  distance  and  energy  control.  Then  our  goal  is  to  find  the  optimum  control  law  which  minimizes  (4)  subject  to  (6). 

This  is  a  linear  quadratic  optimal  control  problem  and  its  solution  is  a  two-point  boundary  value  problem,  which  can  be  expressed  in 
the  form  of  a  Riccati  equation  [28,29].  By  using  the  analytic  representation  of  its  solution  [30],  it  is  easy  to  show  that  [27] 

u*  =  -L~^BT0T(tf,  t)F  [X(tj)  —  XjJ  (8) 

where 


X(tf)  = 


/  + 


rcf  1  1 

/  0(tf,  T)BL~1BT0T(tf,  r)Fdr 


x  [<P(tf,t)X(t)-Xf]  +Xf 


<P(t,t0)  =  A<P(t,t0),  0(t,to)  =  I 


O) 


The  term  @(tf,  t)  X(t)  is  the  predicted  state  without  control  effect,  i.e.  u(r)  =  0(t<  r  <  tf).  The  quantity  pre-multiplying  it  in  (8)  can  be 
viewed  as  a  time  varying  gain  matrix. 

Because  we  are  concerned  about  the  minimization  of  the  miss  distance,  the  terminal  impact  angle  and  terminal  acceleration,  the 
corresponding  terminal  constraints  become  Xf=  (0,  0,  0,  x4f)T,  thus  the  weighting  matrices  F  and  L  can  be  chosen  as 


7i  0  0  0 

0  f2  0  0 
0  0  f3  0 
0  0  0  0 


1  =  1. 


(10) 


From  (6),  we  can  get  transfer  functions  as  shown  by  (1 1 ). 

*l(s)  =  1 

x2(s)  s 
X2OO  =  1 

*3(s)  (As -2/Tg) 
xi(s)  1 
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X3(S)  ps(s-2/Tg) 

Let  us  X(s)  and  u(s)  be  Laplace  transform  of  state  vector  X(s)  and  scalar  input  u(s),  respectively,  then  for  zero  initial  condition,  the  state 
transition  matrix  can  be  provided  by  inverse  Laplace  transform. 
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^(s)  =  xi(s)/x3(s)  is  the  transfer  function  from  aD  to  (XD  +  yDF),  S2{s)  =  x2{s)lx3{s)  the  transfer  function  from  aD  to  XD,  aD(s)laD{ 0)  the 
autopilot  acceleration  response  to  initial  condition  in  the  acceleration  state,  and  aD(s)lpD(0)  the  autopilot  acceleration  response  to  initial 
conditions  in  the  states  po,  and Pd(s)/<3d( 0)  the  states  response  to  initial  conditions  in  the  acceleration  state,  Pd(s)/Pd(0)  the  states  response 
to  initial  conditions  in  states  pD ,  aD(s)/u( 0)  is  autopilot  transfer  function. 
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Substituting  (7),  (10)  and  (13)  into  (8),  a  general  expression  of  the  optimal  control  is  given  by 


=  -L~'BT0T(tf,  t)F  [X(tf)-Xf\  =  - 


’{Si (s)^}^+/2x2(t/)L  1  js2(s)^}^+/3x3(t/)L 


l  u(s)  Jt/_t 


(14) 


In  order  to  avoid  the  inverse  operation  of  4  x  4  matrix,  we  should  multiply  the  two  sides  of  (9)  by  /  +  Jff/  0(tf,  x )BL  1BT0T{tf,  r)Fdr, 
then  the  terminal  states  Xi(tj),  *2 (t/)  and  x3(tj)  can  be  obtained  by  substituting  (7),  (10),  (12)  and  (13)  into  (9) 

*1  (£/)  =  [CnXi  +  [Cn(t/  -  t)  +  C12]  X2  +  (Cn0i3  +  Ci2023  +  Ci 3 033 )X3  +  (Cn^i4  +  CU<p24  +  Ci3^34)x4]  (15) 

*2 (f/)  =  ^  [C21X1  +  [c2i(tj  -  t)  +  C22]  X2  +  (C21013  +  C22  02 3  +  C2 3033 )x3  +  (C21  ^»14  +  C22<p24  +  C23<p34)X4]  (16) 

*3(f/)  =  [C31*l  +  [C3l(t/  -  f)  +  C32]  X2  +  (C31 013  +  C32  023  +  C33 033 )x3  +  (C3i<pi4  +  C32W24  +  C33^34)X4]  (17) 

where 


A  =  It]  1  /<22/<33  +  It 12^23^31  +  It  13^21  It 32  —  It  13^22^31  —  It  12^21^33  “  ^11^23^32 

C11  =  It 22 It 33  —  It 23 It 32 1  Q2  =  It\3It32  ~  ^12^33?  C13  =  /<12^23  —  It] 3 It 22 

c 21  =  It 23  It 31  -  It 21  It 3 3  ?  C22  =  K11K33  -  /<13/<31 ,  C23  =  It]3It2i  -  It]  \  It23 

C31  =  It2]It32  ~  It32 It 31  j  C32  =  It  12 It 31  -  It]  1  It32 ,  C33  =  It\\It22  ~  It  12^21 


Kll  =  l+/l  [f  L2,dr,Ku=f2  [f  L,L2dr,K,3=f3  [ 

V 

L\L3dx 

Jt  Jt  Jt 

ff  ff  n  f 

It 21  =fl 

/  L\L2dT,K22  =  1  +/2  /  l\dT,K23  =  f 3  / 

L2L3dx 

j 

It  Jt  Jt 

rrf  rrf 

l< 31  =/l 

/  l\l3dx,  It32  =f2  /  L2L3dx,  It33  =  1  +/3 

/  L^dx 

J  t 

L,=L~'] 

ML- 

,  l3=l 

r-t 

ap{s) 

U{s ) 


} 


t/-t 


Eqs.  (14-17)  are  the  general  formulation  of  terminal  optimal  guidance  law  with  arbitrary  system  order  to  minimize  the  terminal 
acceleration  in  addition  to  the  miss  distance  and  terminal  impact  angle  of  the  weapon.  We  can  easily  prove  that  the  terminal  states  Xi(tj), 
x2(tf)  and  x3(tf)  remain  constant  when  the  optimal  control  u  is  applied,  so  the  optimal  control  u  is  a  linear  combination  of  a  step  response, 
a  ramp  response  and  in  impulse  response  of  the  weapon.  Obviously,  if  we  set/2=/3=0,  the  resultant  optimal  guidance  law  only  concerns 
minimizing  miss  distance  and  is  approximately  equals  to  PNG  [27].  And  if  we  have  only/3=0,  the  resultant  optimal  guidance  law  concerns 
minimizing  miss  distance  and  terminal  impact  angle  simultaneously,  and  is  approximately  equals  to  the  guidance  law  of  [1 1  ]. 


4.  Optimal  guidance  law  for  lag  free  system 


Because  there  are  many  delay  factors  in  guided  weapon  system  such  as  autopilot,  actuator  and  dynamics,  the  guidance  law  for  lag  free 
system  may  seems  to  weaken  its  real  applications.  In  this  section,  however,  we  first  derive  the  optimal  guidance  law  for  lag  free  system 
because  of  its  simplicity,  and  then  we  investigate  the  specific  formulation  of  the  optimal  guidance  law  for  first-order  lag  system  in  the  next 
section. 

If  the  transfer  function  of  the  weapon  is  assumed  as  lag  free  system 


ap{s) 

u{s ) 


(18) 


Then,  we  can  neglect  x3,  x4  and  f3.  Substituting  (18)  into  (15)  and  (16),  and  considering  Ts~trt  and  let/i^  oo,/2^  00,  we  can  obtain 


Cl  =  ^-(1  +e2)X](t)+  ^-(3  +  e2)x2(t) 

C2  =  ^(1  +  e2)x1(t)  -  A  ^x2(t) 

lg  g  1  e 

Substituting  last  two  equations  into  (14-17),  the  optimal  guidance  control  for  lag  free  system  can  be  calculated  such  that 

*  *  /  „  7 .  p  ..  3  +  p  .  . 

a*  =  u*  =  (1  -  e2)^x,(t)  +  2(1_e2)  ^x2(t) 


(19) 
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where  e  is  the  base  of  index.  Moreover,  considering  (19)  and  the  approximate  relation  aD  «  -pyo,  the  simple  form  of  the  optimal  guidance 
law  can  be  obtained  as  follows. 


Yd  =  — 
p 


,2 \^d  +  Ydf  .  3  +  e4 


2(1  -e2 


■kD  «  -6.389 


+  yDF 


-4.508AD 


(20) 


Eq.  (20)  is  the  optimal  guidance  law  in  diving  plane  for  lag  free  system.  It  is  equivalent  to  an  amendatory  proportional  guidance  law 
with  a  terminal  angular  constraint  item,  which  not  only  satisfies  the  miss  distance  and  impact  angle  constraints,  but  also  minimizes  the 
control  energy  cost. 


5.  Optimal  guidance  law  for  first-order  lag  system 

Although  the  guidance  laws  for  lag  free  system  are  still  used  in  real  application  because  of  its  simplicity,  its  simple  readability  comes  at 
the  expense  of  performance.  Furthermore,  the  development  of  modern  guidance  laws  comes  from  the  requirement  for  better  performance, 
which  can  be  achieved  by  consideration  of  the  detailed  dynamics  of  the  weapon.  Considering  a  higher  order  lag  system  when  developing 
the  optimal  guidance  law  can  improve  the  stability  and  the  command  behavior  near  the  impact  instant,  so  it  is  necessary  for  us  to  derive 
the  formulation  of  the  optimal  guidance  law  for  higher  order  lag  system  and  investigate  its  properties. 

We  cannot  exactly  model  the  system  delay,  but  the  weapon  transfer  function  can  be  approximated  by  first-order  lag  system  as  follows. 


flp(s)  =  1 

u{s)  Ts  + 1 


(21) 


where  T  is  the  time  constant.  Then  we  can  eliminate  X4.  The  optimal  guidance  command  under  this  approximation  can  be  derived  by 
substituting  (21)  into  (14-17)  as  shown  by  (22).  Here  we  consider  Tg  =  tf-t  and  let/i^  00, /2  00, /3  00. 

a*D  =  -T  [G1(t)x1(t)  +  C2(t)x2(t)  +  C3(t)x3(t)]  =  -1  [C,(t)(AD  +  yDF)  +  G2(t)XD  +  C3(t)aD]  (22) 

where 


A  =  1A22A33  +  2A12A13A23  -A23A22  -A22A33  -A23Ah 

Gi(t)  =  LiGn  +  L2G \2  +  T3G i3,  G2(t)  =  LiG2i  +  L2G22  4-  L3G23,  G3(t)  =  LiG3i  +  L2G32  +  L3G33 


G11  =^22^33  -^23>  G21  =  (^22^33  -  A23  )Tg  +  (Ai3A23  -  Ai2A33) 

£31  =  013(^22^33  ~^23)  +  023^13^23  -  A12A33  )  +  033(A12A23  -A13A22) 
G12  =^13^23  -^12^33,  G22  =  (Ai3A23  -  Ai2A33)Tg  +  (AnA33  -  A23) 

^32  =013(^13^23  -^12^33)  +  023(^11^33  “  ^i3 )  + 033^12^13  -^nA23) 

Gi3  =^12^23  -^13^22,  G23  =  (A12A23  -A13A22)Tg  +  (A12A13  -AnA23) 
G33  =013(^12^23  -  Ai3A22)  +  023(Ai2Ai3  - AnA23)  +  033(AhA23  -A22) 
If  we  let  a  =  -2/Tg,  5  =  1/T,  then 


^12  = 


25(1  -e2)  1  -e~2bTs 


P2{b  -  a ) 


Au=b- 


1  -e 


,-bTe 


b2(l  -  e4 
2 a3(a-b)2  '  a3(a-b) 


b(  1-e4)  1  -  e2  1  -  e~2bTs 

+  +  2b(a  -  b) 

1  _  e2-bTg  ' 


1  -e 


-brs 


25(1  -e2~bTz) 
2  5(a-5)2  ab(a-b)  a(a-5)2(a  +  5 ) 

1  _  e~bTg  }  _  e2-bTg 


2 a2(a  -  b )  a2 
5(1  -  e~2bTs ) 


ab 


a(a-5)(a  +  5)  2  5(a  -  5) 
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a(a  -  b) 
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52 
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1  _  e2-bTg  ^  _  g-2bTg 

a  +  b 


Li  =  - 


1 

-  +  ■ 


1 


25 


o-bla 


A33  =  2d-e-2bTg) 


p  La  a(a  -  5) 
Let  aD(s)/aD(0)  =  1  /s,  then 


(a -5) 


f  2  = 


p(5-a) 


(e2  -  e 


-big 


L3  =  be 


,-bTcr 


013  =  ^23  =  _  e2^’  033  =  1 

pa2  pa 

Also  taking  into  account  the  approximate  relation  ao  ~  -p/D,  we  can  obtain  the  simple  form  of  the  optimal  guidance  law. 

yo  =  [Gi(t)(AD  +  yDf)  +  G2(t)AD  +  G3(t)aD]  (23) 

Eq.  (23)  represents  the  optimal  guidance  law  with  miss  distance,  impact  angle  and  terminal  acceleration  constraints  for  first-order  lag 
system,  which  is  equivalent  to  an  amendatory  proportional  guidance  law  with  two  terminal  constraint  items  and  has  the  feedback  form 
of  state  variables  such  as  position,  velocity  and  acceleration. 


Table  1 

Numerical  values  for  simulation. 
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Symbol 

Variable 

Value  (unit) 

xQ,yo,zQ 

Weapon  position 

(10,16,-10)  (km) 

vo 

Weapon  velocity 

1360  (m/s) 

0o 

Initial  heading  angle 

-10 (deg) 

(TO 

Initial  deflection  angle 

-120 (deg) 

Ydf 

Impact  angle 

-88 (deg) 

Fig.  2.  Comparison  of  height- range  profiles  for  the  ground  strik¬ 
ing. 


Fig.  4.  Comparison  of  flight  path  angle  profiles  for  the  ground 
striking. 


Fig.  3.  Comparison  of  velocity  profiles  for  the  ground  striking. 


Time(s) 


Fig.  5.  Comparison  of  angle  of  attack  profiles  for  the  ground 
striking. 


6.  Simulation  results 

In  order  to  investigate  the  properties  of  the  derived  optimal  guidance  laws  with  terminal  angle  of  attack  constraint,  we  compare  them 
with  the  optimal  guidance  law  derived  in  Ref.  [26]  through  3-dimensional  nonlinear  simulations  with  the  initial  conditions  shown  in 
Table  1.  We  choose  the  conventional  navigation  guidance  law  as  the  common  guidance  of  these  three  cases  in  the  turning  plane  so  as  to 
enhance  the  comparability. 

In  these  simulations,  three  different  kinds  of  optimal  guidance  laws  to  control  impact  angle  and  terminal  angle  of  attack  under  the  con¬ 
sideration  of  the  initial  conditions  above  are  employed  for  performance  comparison:  OGL1  stands  for  the  optimal  guidance  law  presented 
in  Ref.  [26],  OGL2  for  the  optimal  guidance  law  for  lag  free  system  shown  by  (20),  and  OGL3  for  the  optimal  guidance  law  for  first-order 
lag  system  shown  by  (23).  It  is  assumed  that  the  weapon  is  a  first-order  lag  system  with  0.5  s  time  constant  and  all  the  state  variables 
can  be  perfectly  measured.  These  simulation  tasks  are  carried  on  a  PC  with  2G  memories  and  Intel(R)  Core(TM)  2  Duo  CPU.  The  version  of 
MATLAB  is  R2009a. 

The  simulation  results  are  presented  by  Figs.  2-6  and  Table  2. 

Fig.  2  represents  the  trajectories  of  the  missile  under  the  above  conditions  using  OGL1 ,  OGL2  and  OGL3.  All  of  the  guidance  laws  complete 
guidance  goal  together.  It  is  observed  that  the  trajectories  of  the  weapon  using  OGL2  and  OGL3  deviate  from  initial  LOS  more  than  the  other 
one.  Fig.  3  shows  the  velocity  profiles  of  the  weapon.  In  the  cases  of  the  two  derived  guidance  laws  OGL2  and  OGL3,  The  average  magnitude 
of  velocity  is  bigger  than  OGL1.  Fig.  4  shows  flight  path  angle  profiles  of  these  three  guidance  laws.  All  of  them  meet  the  terminal  impact 
angle  requirement,  but  the  flight  path  angle  variation  curve  of  OGL1  is  more  stable  than  others.  Figs.  5  and  6  represent  the  angle  of  attack 
profiles  and  the  acceleration  profiles,  respectively.  In  the  cases  of  OGL2  and  OGL3,  their  maximum  magnitude  of  acceleration  in  terminal 
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Fig.  6.  Comparison  of  normal  load  factor  profiles  for  the  ground  striking. 


Table  2 

Comparison  of  simulation  results. 


OGL 

Vf(mls) 

A<9/(deg) 

CEP  (m) 

o<f(  deg) 

1 

674.1257 

-0.0169 

0.0791 

-0.4902 

2 

677.0112 

-0.0609 

0.0535 

-0.0401 

3 

677.8680 

-0.0052 

0.0693 

-0.0042 

phase  is  smaller  than  OGL1  and  converges  to  zero  at  final  time  as  well.  This  is  the  most  distinct  property  of  the  proposed  optimal  guidance 
laws  with  terminal  angle  of  attack. 

By  analyzing  the  simulation  results,  we  can  find  that  the  two  derived  optimal  guidance  laws  with  terminal  angle  of  attack  constraint 
have  equivalent  hit  accuracy,  impact  angle  error  and  terminal  velocity  when  compared  with  the  conventional  guidance  law  with  terminal 
impact  angle  constraint,  but  possess  better  performance  on  the  terminal  angle  of  attack  control.  These  new  derived  guidance  laws  can 
achieve  zero  angle  of  attack  impact  on  the  whole,  which  play  an  important  role  in  the  air-to-surface  penetrating  weapons.  Moreover, 
when  comparing  the  simulation  results  of  OGL2  and  OGL3,  the  OGL3  for  first-order  lag  system  have  higher  stability  and  better  guidance 
performance  at  final  time,  which  proves  that  considering  a  higher  order  lag  system  when  deriving  the  optimal  guidance  law  can  improve 
the  stability  and  the  command  behavior  near  the  impact  instant. 

7.  Conclusion 

In  this  paper,  a  general  formulation  of  terminal  optimal  guidance  law  with  an  arbitrary  system  order  is  deduced  by  solving  the  Riccati 
equation  of  the  linear  quadratic  optimal  control  problem  to  null  the  miss  distance  and  achieve  a  desired  impact  angle  as  well  as  control 
the  terminal  angle  of  attack.  The  approximate  expressions  of  the  optimal  guidance  laws  for  lag  free  system  and  first-order  lag  system  are 
given.  The  performance  of  the  derived  optimal  guidance  laws  with  terminal  angle  of  attack  constraint  are  investigated  by  comparable 
simulations  with  the  conventional  terminal  guidance  law.  An  important  feature  of  the  derived  optimal  guidance  laws  with  terminal  angle 
of  attack  is  a  linear  combination  of  a  step  response,  a  ramp  response  and  in  impulse  response  of  the  weapon.  The  most  distinct  property  of 
the  proposed  optimal  guidance  laws  with  terminal  angle  of  attack  is  the  magnitude  of  angle  of  attack  in  terminal  phase  converges  to  zero 
at  final  time. 

Furthermore,  we  can  find  from  the  simulation  results  that  the  proposed  energy  minimization  optimal  guidance  law  for  first-order 
lag  system  can  not  only  shows  small  CEP  and  angle  of  attack  at  final  time,  but  also  presents  good  guidance  performance,  which  proves 
that  guidance  laws  for  higher  order  lag  system  have  good  command  behavior  and  robustness  to  system  disturbances  and  uncertainties 
in  terminal  phase.  However,  the  guided  weapons  must  face  up  to  some  severe  conditions  and  typical  constraints  such  as  heating  rate 
constraint,  normal  load  factor  constraint  and  dynamic  pressure  constraint  that  have  to  be  considered  during  the  on-line  applications.  So 
it  is  necessary  for  us  to  develop  appropriate  guidance  laws  which  can  not  only  satisfy  multiple  constraints  but  also  minimize  specific 
performance  index. 
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